#include "wertezuweisung.h"

void werte(void)
{
	
	const int b=10;
	const int fb=3;

	r1=10;
	r2=2;
	r3=7;
	l=100;




	//Roboterarm 1:
/*	robo1[0][0]=-r1;
	robo1[0][1]=0;
	robo1[1][0]=-r1;
	robo1[1][1]=-l;
	robo1[2][0]=r1;
	robo1[2][1]=-l;
	robo1[3][0]=r1;
	robo1[3][1]=0;
	robo1[4][0]=0;
	robo1[4][1]=0;
	robo1[5][0]=0;
	robo1[5][1]=-l;
*/	robo1 = initListe();
	addPunktxy(robo1, -r1, 0);
	addPunktxy(robo1, -r1, -l);
	addPunktxy(robo1, r1, -l);
	addPunktxy(robo1, r1, 0);
	addPunktxy(robo1, 0, 0);
	addPunktxy(robo1, 0, -l);
	
	//Roboterarm 2:
	robo2 = initListe();
	addPunktxy(robo2, -r3, 0);			//Handhöhe 20
	addPunktxy(robo2, -r3, -l+10);		
	addPunktxy(robo2, -b/2, -l+10);
	addPunktxy(robo2, -b/2, -l+b+10);
	addPunktxy(robo2, b/2, -l+b+10);
	addPunktxy(robo2, b/2, -l+10);
	addPunktxy(robo2, r3, -l+10);
	addPunktxy(robo2, r3, 0);
	addPunktxy(robo2, 0, 0);
	addPunktxy(robo2, 0, -l);


 
	//Offene/geschlossene Hand:
	hand = initListe();
	addPunktxy(hand, -2*fb, 2*b);
	addPunktxy(hand, -2*fb, b);
	addPunktxy(hand, -3*fb, b);
	addPunktxy(hand, -3*fb, -b/2);
	addPunktxy(hand, -2*fb, -b/2);
	addPunktxy(hand, -2*fb, b/2);
	addPunktxy(hand, -2*fb, -b/2-h*b/2);
	addPunktxy(hand, -fb, -b/2-h*b/2);
	addPunktxy(hand, -fb, b/2);
	addPunktxy(hand, -fb, -b/2-h*b/1.7);
	addPunktxy(hand, 0, -b/2-h*b/1.7);
	addPunktxy(hand, 0, b/2);
	addPunktxy(hand, 0, -b/2-h*b/2);
	addPunktxy(hand, fb, -b/2-h*b/2);
	addPunktxy(hand, fb, b/2);
	addPunktxy(hand, fb, -b/2);
	addPunktxy(hand, 2*fb, -b/2);
	addPunktxy(hand, b/2, 2*b);	
	addPunktxy(hand, 0, 0);

	
	//Schweißgerät
	schweisser = initListe();
	addPunktxy(schweisser, 0, 0);
	addPunktxy(schweisser, -2, 2);
	addPunktxy(schweisser, -2, 10);
	addPunktxy(schweisser, -b/2, 10);
	addPunktxy(schweisser, -b/2, 10+b);
	addPunktxy(schweisser, b/2, b+10);
	addPunktxy(schweisser, b/2, 10);
	addPunktxy(schweisser, 2, 10);
	addPunktxy(schweisser, 2, 2);
	


	//Lichtstrahlen beim Schweißen
	feuer = initListe();
	addPunktxy(feuer, 0, -7);
	addPunktxy(feuer, 6, -5);
	addPunktxy(feuer, 7, 2);
	addPunktxy(feuer, 3, 6);
	addPunktxy(feuer, -3, 6);
	addPunktxy(feuer, -7, 2);
	addPunktxy(feuer, -6, -5);
	addPunktxy(feuer, 0, 0);
}
